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ABSTRACT 


This  project  aims  to  design,  implement,  and  assess  the  performance  of  an 
unmanned  surface  vessel  (USV)  path  planning  with  potential  fields.  The 
proposed  algorithms  are  adaptations  of  the  general  potential  field  navigation 
method,  tailored  for  the  specific  dynamics  of  USV  path  planning.  A  piecewise 
linear  potential  field  model  was  implemented  on  a  Clearpath  USV  using  MATLAB 
and  Simulink.  The  USV  model  and  piecewise  linear  potential  field  model  were 
tested  in  a  Gazebo  simulation  and  in  the  field.  The  simulations  and  real-world 
tests  were  compared  to  evaluate  the  performance  of  the  potential  field 
algorithms.  The  USV  interacted  with  the  repulsive  and  attractive  fields 
successfully  to  maneuver  around  obstacles  and  boundaries  to  reach  the 
objective. 
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I.  INTRODUCTION 


A.  MOTIVATION 

There  are  many  potential  applications  for  robotic  vehicles  in  defense  and 
security.  The  Navy  works  with  a  variety  of  autonomous  vehicles  in  restricted 
environments  with  limited  intelligence  about  the  areas.  These  platforms  are  force 
multipliers  that  can  reduce  the  risk  to  personnel,  conduct  tasks  that  humans 
cannot,  and  be  cost  effective  [1].  The  ability  for  the  vehicles  to  maneuver  safely 
and  efficiently  in  a  coordinated  manner  while  collecting  data  is  invaluable.  Path 
planning  is  a  fundamental  capability  for  simultaneous  operation  and  obstacle 
avoidance  of  such  systems.  One  specific  method  for  path  planning  is  to  use 
potential  field  algorithms  to  avoid  obstacles,  prevent  collisions,  travel  to 
waypoints,  and  surround  objects  of  interest.  This  thesis  will  involve  the 
development  of  potential  field  based  path  planning  for  an  unmanned  surface 
vehicle  (USV)  to  transit  safely  around  obstacles  and  reach  a  specified  location. 

B.  PROBLEM  STATEMENT 

The  objective  of  this  research  is  to  design,  implement,  and  assess  the 
performance  of  USV  path  planning  using  potential  fields.  Piecewise  linear 
potential  fields  were  applied  in  computer  simulations  and  field  experiments  using 
the  Clearpath  Robotics  USV  pictured  in  Figure  1  [2].  The  attractive  potential 
fields  (targets)  and  repulsive  potential  fields  (obstacles)  were  modeled  as  circles. 
The  repulsive  boundary  lines  were  developed  as  perpendicular  potential  fields. 
Evaluating  local  minima  was  not  in  the  scope  of  this  research  due  to  the  focus  of 
developing  a  dynamic  model  of  the  USV  and  testing  it  using  potential  field 
algorithms. 


1 


Figure  1 .  Clearpath  Robotics  USV 

C.  PREVIOUS  AND  POTENTIAL  APPLICATIONS  OF  UNMANNED 
SURFACE  VEHICLES  FOR  THE  NAVY 

The  United  States  Navy  has  been  developing  and  using  USVs  since  the 
end  of  World  War  II  to  conduct  minesweeping,  as  shown  in  Figure  2,  and  battle 
damage  assessment  (BDA)  operations  [1].  These  vehicles  were  remotely 
controlled  and  lacked  autonomous  capabilities,  but  reduced  the  risk  to  manned 
forces  while  accomplishing  the  mission. 
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Figure  2.  U.S.  Navy  Minesweeping  Drone  from  the  Late  1960s. 

Source:  [1]. 

The  Navy  has  continued  to  develop  and  expand  the  use  of  unmanned 
systems  through  experimentation  and  experience.  Minesweeping  capabilities 
have  increased  through  further  automation,  longer  operational  time,  and  larger 
coordinated  search  patterns.  USVs  are  being  used  for  intelligence,  surveillance, 
and  reconnaissance  (ISR)  missions  in  high-risk  areas  with  different  levels  of 
autonomy  [1], 

In  [1],  the  Navy  has  stated  that  all  USVs  must  have  the  ability  to 
autonomously  avoid  obstacles  and  that  technical  development  is  needed  in  this 
area.  Potential  field  algorithms  have  been  gaining  in  popularity  for  use  in  obstacle 
and  collision  avoidance  and  path  planning.  The  algorithms  could  be  implemented 
to  enable  the  USVs  to  surround  enemy  vessels  at  a  specific  distance,  escort  or 
protect  friendly  vessels,  and  transit  with  other  manned  or  unmanned  platforms  [3]. 
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II.  BACKGROUND 


A.  ARTIFICIAL  POTENTIAL  FIELD 

In  [4],  Latombe  describes  the  potential  function  as  the  sum  of  the 
attractive  potential  and  repulsive  potential  energies  acting  on  the  robot.  The 
robot,  which  is  treated  as  a  point  in  the  configuration  space,  is  pulled  by  the 
attractive  potential  toward  a  defined  target  and  pushed  away  from  obstacles  by 
the  repulsive  potential.  The  potential  field  forces  are  shown  in  Figure  3. 


Figure  3.  Model  of  Artificial  Potential  Field.  Source:  [5]. 


The  motion  planning  of  the  potential  function  is  performed  iteratively  by 
calculating  the  artificial  force  F(q)  =  -VU(q )  induced  by  the  potential  function  at 

each  iteration,  where  F  is  the  force  vector  and  VU  is  the  gradient  of  the  potential 
field  function.  A  path  is  generated  along  the  direction  of  motion  of  the  artificial 
force  at  each  increment  [4]. 

The  basic  potential  functions  are  summed  in  order  to  make  the  robot 
attracted  toward  targets  and  repulsed  by  obstacles: 


U(q)  =  Uatt(q)  +  Urep(q), 
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(1) 


where  Uatt  is  the  attractive  potential  and  Urep  is  the  repulsive  potential  [4].  The 
gradient  function  of  the  attractive  and  repulsive  forces  are 


F  an  -  -VUatt  , 

Frep  =  -VUrep , 

F  =  Fait  +  F  rep  , 


(2) 

(3) 

(4) 


where  F  is  the  sum  of  the  two  vectors  [4].  Specifying  the  appropriate  potential 
functions,  which  generate  the  virtual  forces  on  a  robotic  platform,  is  critical  to  the 
application  of  the  method. 

1 .  Parabolic  Attractive  Potential 

One  common  attractive  potential  function  is  a  parabolic  function  [4],  In 
such  an  implementation  the  potential  function  is 


(5) 


where  e  is  a  positive  gain  factor  of  attraction  and  pgoal  is  the  distance  between 
the  robot  and  the  goal  ||<?  -  || .  When  the  robot  reaches  the  goal  ua,Mgoal)  =  o 

[4].  The  derivation  of  the  attractive  force  from  the  potential  is: 


Fa,t(q)  =  -VUatt(q ) 

=  -£PgoaMljVpg(Jq) 
=  -£(q-qgoai\ 
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where  Fa„  converges  linearly  as  the  robot  gets  closer  to  the  goal  [4].  Figure  4 
shows  an  attractive  potential  field. 


Figure  4.  Attractive  Potential  Field.  Source:  [4]. 

2.  Parabolic  Repulsive  Potential 

Similarly,  a  common  repulsive  potential  function  is: 


Urep(q)  = 


->]( 


p(q) 


— )2 

A>' 


0 


if  p(q)  ^  p0 
ifp(q)  >  p0 


(7) 


where  77  is  a  positive  gain  factor  of  repulsion  and  p(q)  is  the  distance  between 
the  robot  and  the  obstacle  \q  - qohslacle ||  [4].  The  repulsive  potential  field  of  an 

obstacle  is  designed  to  not  influence  the  robot  when  it  is  outside  the  distance  of 
influence  p0 . 
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The  derivation  of  the  repulsive  force  from  the  potential  is: 


FreP(q)  =  -VUrep(q) 

=.  <8) 

0  ifp(q)  >  p0 

Once  the  robot  is  inside  the  distance  of  influence,  the  repulsive  force  is 
positive  and  goes  to  infinity  as  the  robot  moves  closer  to  the  obstacle  [4],  Figure 
5  displays  a  repulsive  potential  field. 


Figure  5.  Repulsive  Potential  Field.  Source:  [4], 

3.  Weaknesses  of  the  Potential  Field  Method 

The  weaknesses  of  the  artificial  potential  field  method  are  that  at  certain 

points  during  the  transit  of  the  robot  F  may  be  zero  [5].  This  could  cause  the 
robot  to  stop  moving  or  circle  around  a  point  and  is  called  the  local  minimum  of 
the  potential  function  [5].  In  addition,  the  potential  field  path  of  the  robot  may  not 
converge  when  there  are  too  many  obstacles.  The  robot  would  then  not  be  able 
to  reach  the  goal  or  target  [5]. 
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The  issue  of  local  minima  can  be  reduced  by  designing  a  function  that 
limits  how  many  local  minima  are  present  or  provides  a  method  to  escape  from 
the  local  minimum  [4]. 

B.  IMPLEMENTED  POTENTIAL  FIELD  MODEL 

The  potential  field  that  was  selected  for  the  Clearpath  Robotics  USV  was 
based  upon  Goodrich’s  piecewise  linear  potential  field  algorithm  in  [6].  It  was 
selected  due  to  the  flexibility  and  simplicity  of  implementing  the  piecewise  linear 
potential  fields  in  MATLAB  and  Simulink.  The  piecewise  linear  equations  could  be 
modified  for  different  geometries,  and  the  strength  of  the  fields  was  easily  adjusted. 
The  attractive  force  is  calculated  by  finding  the  distance  between  the  goal  and  the 
USV: 


d  =  \l(x^-xfHy-y^)2 


(9) 


where  xG  and  yG  is  the  position  of  the  goal  and  x  and  y  is  the  position  of  the 
USV.  The  angle  between  the  USV  and  the  goal  is  determined  by 


0  =  tan-1  (-^j)  . 

XG  ~x 


(10) 


The  forces  in  the  x  and  y  directions  are  evaluated  using  an  if-else  if 
statement: 


if  d  <r 

if  r  <  d  <  s  +  r 

if  d  >  s  +  r 


Ax  =  Ay  =  0 

Ax  =  a(d  -r)cos(d)  and  Ay  =  a(d  -  r)sin(#) 
Ax  =  as  cos(d)  and  Ay  =  as  sin(60. 


(11) 
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The  goal  is  modeled  as  a  blue  circle  with  radius  r  in  Figure  6,  and  when 
the  USV  is  inside  the  radius,  there  are  no  forces  acting  upon  it.  The  attractive 
field  has  a  radius  of  influence  5  and  the  USV  senses  a  proportion  of  the  max 
force  when  it  is  between  r  and  s  +  r.  Outside  the  radius  of  influence,  the  max 
attractive  force  acts  on  the  USV  and  drives  it  toward  the  goal.  This  is  shown  in 
Figure  6.  The  arrows  represent  the  magnitude  and  direction  of  the  attractive 
potential  field.  A  constant  positive  gain  a  is  included  to  scale  the  strength  of  the 
attractive  force  [6]. 
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The  blue  circle  is  an  attractive  potential  field  or  a  goal  of  the  USV. 
Figure  6.  Attractive  Potential  Field.  Adapted  from  [6]. 


The  repulsive  force  is  calculated  by  finding  the  distance  between  the 
obstacle  and  the  USV: 


d  =  ^[{x^-xfw{ y-y0)2  , 


(12) 
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where  x0  and  y0  is  the  position  of  the  obstacle  and  x  and  y  is  the  position  of 
the  USV.  The  angle  between  the  USV  and  the  obstacle  is  determined  by 


0  =  tan_1(^j) . 


(13) 


The  forces  in  the  x  and  y  directions  (Ax  and  Ay  respectfully)  are  evaluated  using 
an  if-else  if  statement: 


if  d  <r  Ax  =  -(cos(#))°°  and  A y  =  -(sin(#))oo 

ifr<d<s  +  r  Ax  =  -/3(s  +  r-d)  cos(0 )  and  Ay  =  -J3(s  +  r-d)sin(0)  (14) 
if  d  >  s  +  r  Ax  =  Ay  =  0. 
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The  obstacle  is  modeled  as  a  pink  circle  in  Figure  7  with  radius  r  and 
when  the  USV  is  inside  the  radius  the  max  repulsive  force  acts  on  it.  The 
repulsive  field  has  a  radius  of  influence  s  and  the  USV  senses  a  proportion  of 
the  max  force  when  it  is  between  r  and  s  +  r .  Outside  the  radius  of  influence,  the 
repulsive  potential  field  is  zero  in  order  to  prevent  an  obstacle  from  interfering 
with  the  USV  path  and  is  presented  in  Figure  7.  The  arrows  represent  the 
magnitude  and  direction  of  the  repulsive  potential  field.  A  constant  positive  gain 
p  is  included  to  scale  the  strength  of  the  repulsive  force  [6]. 


The  pink  circle  is  a  repulsive  potential  field  or  an  obstacle  for  the  USV. 
Figure  7.  Repulsive  Potential  Field.  Adapted  from  [6]. 
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The  repulsive  and  attractive  vectors  are  combined  to  find: 


Ax  =  A0x  + Agx 
Ay  =  A0y  +  AGy. 


(15) 


The  formulations  in  Equations  (11),  (14),  and  (15)  are  used  to  generate 
the  combined  potential  field  with  an  obstacle  and  goal  displayed  in  Figure  8.  The 
brown  circle  is  a  repulsive  potential  field  or  an  obstacle  for  the  USV.  The  green 
circle  is  an  attractive  potential  field  or  a  goal  for  the  USV.  The  arrows  represent 
the  magnitude  and  direction  of  the  combined  potential  fields. 
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Figure  8.  Combined  Potential  Field.  Adapted  from  [6]. 
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A  possible  path  for  the  USV  to  transit  around  the  obstacle  (green  circle) 
and  reach  the  goal  (pink  circle)  is  represented  in  Figure  9.  The  arrows  represent 
the  magnitude  and  direction  of  the  combined  potential  fields.  The  black  line  is  a 
possible  path  for  the  USV  to  travel. 


Figure  9.  Path  of  USV  in  Combined  Potential  Field.  Adapted  from  [6]. 

The  combined  potential  field  vectors,  Ax  and  Ay ,  generated  in  Equation 
(15)  are  used  to  find: 


v  =  VAi2  +  A /  ,  (16) 

0  =  tan-‘(£)  ,  (17) 


where  v  is  the  velocity  of  the  USV  and  0  is  the  direction  of  the  USV.  The  USV 

maneuvers  around  the  environment  interacting  with  the  potential  fields  and 

selecting  new  directions  and  speeds  to  reach  the  goal  [6]. 
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1. 


Reasons  for  Piecewise  Linear  Potential  Field  Model 


The  piecewise  linear  potential  field  model  was  selected  due  to  the  ease  of 
incorporating  the  repulsive  and  attractive  forces.  The  size  and  radius  of  influence 
of  the  obstacles  and  goals  was  very  explicit  and  able  to  be  adjusted 
appropriately.  MATLAB  and  Simulink  were  chosen  to  implement  the  high-level 
potential  field  control  and  the  piecewise  linear  formulas  were  straightforward  and 
intuitive. 

2.  Modifications  to  Piecewise  Linear  Potential  Field  Model 

Goodrich’s  formulas  were  adapted  to  run  in  MATLAB  and  Simulink  by 
calculating  the  magnitude  of  the  attractive  and  repulsive  forces  and  then 
determining  the  vector  components.  This  was  done  to  provide  traceability  from 
the  angle  between  the  USV  and  the  goal  (6)  and  the  vector  components  back  to 
the  magnitudes  of  the  potential  forces  in  Simulink.  Troubleshooting  methods 
were  simplified  by  being  able  to  determine  if  there  were  errors  in  the  forces  or  the 
angles  of  the  goals  and  obstacles.  The  attractive  force  had  the  following 
changes: 


d  =  ^(xG-x)2+(yG-y)2 


(18) 


if  d  <r 

if  r  <d  <  s  +  r 

if  d  >  s  +  r 


=  0 


p  =  p 

attractive  max  5 


F  =F 

attractive  max 


(19) 


where  Fmax  is  the  constant  positive  gain  of  the  attractive  force.  The  angle 
between  the  USV  and  the  goal  was  calculated  as  in  Equation  (10). 
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The  magnitude  of  the  attractive  force  was  determined  first  and  then 
separated  into  the  following  vector  components 


^attractive _x  ^attractive  COS($), 
y  —  ^attractive _y  ~  ^attractive 


(20) 


The  repulsive  force  had  similar  changes  and  is  expressed  as: 


d  =  yl(x0-x)2+(y0-y)2 


(21) 


if  d  <  r 

if  r  <d  <  s  +  r 

if  d  >  s  +  r 


F  =-F 

repulsive  max 


=  -F  (i-«z r2) 

max  V  s  / 


repulsive 

F  =  0 

repulsive 


(22) 


where  Fmax  is  the  constant  positive  gain  of  the  repulsive  force.  The  angle 
between  the  USV  and  the  obstacle  was  calculated  as  in  Equation  (13). 

This  potential  field  implementation  provides  the  high-level  path  planning 
for  the  USV,  but  to  do  so,  the  output  of  the  path  planning  must  interface  with  the 
low-level  USV  feedback  control.  For  the  Clearpath  USV,  the  interface  to  the  low- 
level  control  takes  the  form  of  a  “course  command,”  which  includes  a  forward 
(surge)  velocity  and  a  yaw.  For  the  purposes  of  implementation,  the  force  vector 
must  be  converted  from  the  potential  field  path  planning  (force  in  the  x  and  y 
direction)  into  a  course  command  (surge  velocity  and  yaw). 
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The  magnitude  of  the  repulsive  force  was  determined  first  and  then 
separated  into  the  vector  components: 


A 0X  F "repulsive _x  F 'repulsive  COS($X 
A0>;  =  Frepulsive_y  =  Repulsive 


(23) 


The  vector  forces  were  then  summed  to  find  the  total  potential  force  in  the  x  and 
y  directions: 


Ax  AqX  +  AqX  Fx  F repulsive _x  ^  F attractive _x'< 

—  Ao  7  AG  3'  —  Fy  —  F repulsive  _y  F attractive  _  y 


(24) 


The  yaw  of  the  USV  was  calculated  in  radians,  using  the  force  components: 


6  =  tarT^-jf) . 


(25) 


The  speed  of  the  USV  is  proportional  to  the  magnitude  of  the  potential  force: 


Speedusv  Fx  +  Fy  . 


(26) 


The  yaw  and  speed  adjust  as  the  attractive  and  repulsive  forces  act  on  the 
position  of  the  USV. 


17 


Repulsive  potential  line  obstacles  were  also  developed  to  provide 
boundaries  to  the  USV.  The  end  points  of  each  boundary  were  selected  and  the 
slope  of  the  line  was  calculated  by: 


if  k„rf-*stort|<0-01 

slope  =  lxl  06 

else  (27) 


slope  = 


y end  ~  y 


start 


end 


where  xend  /  yend  and  xstart  /  ystan  are  the  points  of  the  boundaries.  The  slope  was 
evaluated  using  an  if-else  statement  to  ensure  that  if  the  boundary  was  a  vertical 
line,  the  slope  would  be  given  a  set  value  of  lxlO6 .  This  was  to  prevent  any  error 
being  carried  forward  in  the  MATLAB  calculations. 

The  slope  of  the  boundary  line  was  used  to  determine  the  perpendicular 
intersection  of  the  current  USV  position  and  the  boundary  line.  An  if-else  if 
statement  was  developed  to  calculate  the  intersection  points: 

if  slope  =  0 

Tnl  y start 

Tilt  —  XUSV 

elseif  \slope\>lt)t)t) 

=  yusv  (28) 

Tnt  start 

else 

Tnt  =  (tStt)  ' (y«sv  -  y start  +  sl°Pe  *  Xs,art  + 

>’,„t  =  (}’s,ar,  +  Slope  *  (Xin(  +  Xstan)) 
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where  xint/yint  are  the  intersection  points  and  xusv  /  yusv  is  the  position  of  the 
USV. 

The  USV  position  and  the  intersection  points  were  calculated  to  evaluate 
the  distance,  d,  from  the  USV  to  the  boundary  line: 


=  ^/(x[/sv-xi„t)2  +  (y[/sv-yjnt)2 


(29) 


The  repulsive  potential  field  boundary  line  is  modeled  as  having  two  parallel 
areas  of  influence,  that  each  has  a  different  repulsive  force  acting  on  the  USV  if  it 
is  inside  the  area.  Outside  the  areas,  the  repulsive  potential  field  is  zero. 

An  if-else  if  statement  is  used  to  determine  the  magnitude  of  the  force 
acting  on  the  USV: 


if  d  <  boundary  1 


F  =F 

repulsive  max 


elseif  d  <  ( boundary  1  +  boundary  2) 

Tp  _  J7  ( 1  (d -boundary  1)  \ 

repulsive  max  ^  boundary  2  ' 

else 


^ 'repulsive  0 


(30) 


where  boundary  1  and  boundary  2  are  the  parallel  areas  of  influence. 

The  angle  between  the  USV  and  the  boundary  line,  6 ,  is  determined  by 


6  =  tarr'C''™'"'1"1)  . 

'  xmv  -  ' 


(31) 
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The  magnitude  of  the  repulsive  line  force  was  determined  first  and  then 
separated  into  the  vector  line  components: 


^ line ^  F repulsive  _x 


Aliney  =  Fr 


repulsive  _  y 


=  F 'repulsive  COS(^)> 
=  Repulsive  Sin(<?)’ 


(32) 


where  Alinex  and  A Uney  are  the  repulsive  line  vector  forces.  The  vector  forces 

from  the  lines,  goal,  and  obstacle  were  then  summed  to  find  the  total  potential 
force  in  the  x  and  y  directions: 


/Ax  -  A0x  +  Agx  +  Alinex  -Fx-  Frepulsive_x  +  Fattractive_x , 


Ay  =  A0y  +  AGy  +  A  liney  =  F  =  Fr 


+  F 

repulsive  _  y  attractive  _  y  ' 


(33) 


The  yaw  of  the  USV  was  calculated  in  radians  using  the  force 
components: 


0  =  tan_1(-^) . 


(34) 


The  speed  of  the  USV  is  proportional  to  the  magnitude  of  the  potential  force: 


Speedusv  -  sjFy  +  F}2  . 


(35) 


The  yaw  and  speed  adjust  as  the  attractive  and  repulsive  forces  act  on  the 
position  of  the  USV. 
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III.  USV  MODELING 


A.  INTRODUCTION 

To  support  development  and  early  testing  of  the  path-planning  algorithms 
described  in  Chapter  II,  a  simulation  was  required  to  represent  the  USV 
dynamics  in  a  virtual  environment.  Without  a  simulation,  field  testing  is  the  only 
method  for  design  iteration,  and  such  field  tests  are  time  consuming,  resource 
intensive  and  limited  in  the  types  of  scenarios  to  be  tested.  For  the  simulation  to 
be  useful  it  is  necessary  that  the  simulated  dynamics  be  similar  to  that  of  the 
actual  vessel,  hence  the  need  to  model  the  physical  parameters  of  the  Clearpath 
USV. 

B.  DYNAMIC  MODEL  OF  THE  USV 

1.  Background 

The  maneuvering  models  described  by  Fossen  [7],  [8]  are  the  basis  for 
many  USV  models.  The  references  contain  a  number  of  different  generic  models 
and  extensions  of  these  models  for  specific  cases.  The  focus  tends  to  be  on  full- 
sized  surface  ships  and  platforms,  but  the  underlying  equations  are  also  relevant 
to  small  USVs. 

2.  Equations  of  Motion 

This  model  contains  second-order  (linear  and  quadratic)  terms  for  the 
dissipative  terms.  In  this  section,  the  notation  and  process  followed  is  detailed  in 
[7],  Chapter  VII.  The  3  degrees  of  freedom  (DOF),  horizontal-plane  maneuvering 
model  uses  the  state  vector  u  =  [u,v,rf  where  the  velocities  u,v,  and  r  are  in 
the  surge,  sway,  and  yaw  directions,  respectively.  The  velocities  are  considered 
to  be  relative  to  an  irrotational  constant  ocean  current. 
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The  nonlinear  maneuvering  equations  from  [7]  are 


MRbV  +  CRB  +  MAVr  +  CA  ( °r  )»r  +  D(Ur  K  =  T  +  ^ wind  ^  waves  5  (36) 

where  or  is  the  velocity  vector  relative  to  an  irrotational  water  current  oc,  i.e., 
u  =  or+oc.  The  linear  and  quadratic  drag  terms  from  [7]  are 


D(vr)  = 


X  +  X  1 1  w  0  0 

u  u\u\  I  I 

0  Fv+Fm|v|  F+FM|r| 

v  V  v  I  I  r  r\r\  \  \ 

o  yv  +  n , , li’l  n+n^IA 

v  v  v  I  I  r  r\r\  \  \ 


(37) 


In  [9],  the  Blanke  model  is  used  with  the  addition  of  the  linear  drag  terms. 
The  simplified  speed  equation  in  the  surge  direction  is 


(m-X.)M  =  Xuu  +  X^u  u  u  +  t(c).  (38) 

RB  and  AM  inertia  '  ~Drag  ^  Thrust 


The  steering  equation  in  the  sway  direction  is 


(m-F.)v 

RB  and  AM  inertia 


( m-Yur)ur 

v - v - ' 

RB  and  AM  Coriolis 


+  Tvv  +  F ,  |  v  v  , 


Drag 


(39) 


and  in  the  yaw  direction  it  is 


C Iz-N.)r  =Nrr  +  Nr^  r  r  +  T(c), 

RB  and  AM  inertia  Drag  Torque 


(40) 
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where  c  is  the  associated  thrust  command  in  Equations  (38)  and  (40). 

The  following  assumptions  are  made: 

•  Speed:  Surge 

•  The  Coriolis  terms  (m  +  Xvr)vr ,  both  rigid  body  and  added 

mass  contributions,  are  negligible  because  the  sway  speed 
is  much  less  than  the  surge  speed. 

•  The  centripetal  terms  (mxg  +Xrr)r2  are  neglected  on  the 
assumption  of  a  low  turn  rate. 

•  Steering:  Sway  and  Yaw 

•  The  rigid  body  and  added  mass  coupling  terms  are 

neglected. 

•  (mxg  -  Y.)r  in  the  sway  equation 

•  (mxg  -N.)v  in  the  yaw  equation 

•  The  rigid  body  and  added  mass  Coriolis  terms  are 

neglected. 

•  ~(mxg  -Nur)ur  in  the  yaw  equation 

•  The  coupled  drag  terms  are  neglected  because  they  are 
negligible. 

•  Yuvuv  and  Y^r  |v|  r  in  the  sway  equation 

•  Nuvuv  and  N^r  |v|  r  in  the  yaw  equation 

•  The  quadratic  term  iV|v|v|v|v  in  the  Blanke  model  is 

substituted  with  a  linear  and  quadratic  term  as  a  function  of 
yaw,  Nrr  +  Nw\r\r. 
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C.  SYSTEM  IDENTIFICATION 

Given  the  equations  of  motion  in  (38-40),  the  next  step  in  developing  a 
model  of  the  Clearpath  USV  is  to  experimentally  identify  as  many  of  the 
parameters  of  the  model  as  possible.  Table  1  describes  the  parameters  and 
methods  of  identification. 


Table  1.  USV  Model  Parameters 


Description 

Variable 

Identification  Method 

Rigid  Body  Mass 

m 

Scale 

Added  Mass,  Surge_ 

Dynamic  Surge  Test 

Linear  Drag,  Surge 

Xuu 

Steady-State  Surge  Test 

Quadratic  Drag,  Surge 

X  i  \u\u 

Steady-State  Surge  Test 

Thrust,  Surge 

t(c) 

Bollard  Pull  Test 

Added  Mass,  Sway 

K 

Not  Identified 

Added  Mass  Coriolis,  Sway 

Kr 

Not  Identified 

Linear  Drag,  Sway 

Not  Identified 

Quadratic  Drag,  Sway 

F, ,  Ivlv 

V  v  |  | 

Not  Identified 

Rigid  Body  Inertia,  Yaw 

h 

Moment  of  Inertia  Calculation 

Added  Mass  Inertia,  Yaw 

Nr 

Dynamic  Yaw  Test 

Linear  Drag,  Yaw 

Nrr 

Steady-State  Yaw  Test 

Quadratic  Drag,  Yaw 

Steady-State  Yaw  Test 

Torque,  Yaw 

T  (c) 

Bollard  Pull  Test  and  Calculation 
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The  sway  parameters  were  not  identified  in  Table  1  due  to  the  sway  speed  being 
negligible  when  compared  to  the  surge  speed. 

1.  Mass  and  Inertia 

a.  Rigid  Body  Mass  and  Moment  Inertia 

The  mass  of  the  Clearpath  USV  is  36.0  kg  as  measured  with  a  spring 
scale.  The  mass  of  the  Clearpath  USV  according  to  the  technical  specifications  is 
28.0  kg  with  no  payload  [2].  The  moment  of  inertia  of  the  USV  was  assumed  to 
be  the  form  of  a  simple  box  with  the  plane  about  the  center.  The  estimated 
moment  of  inertia  is 


,  m(b2  +  w 2)  36(1. 352  +0.982) 

I  = - = - =  8.35  kg  •m  . 


12 


12 


(41) 


b.  Added  Mass  and  Added  Inertia 

The  general  form  of  the  surge  and  yaw  models  in  Equations  (38)  and  (40) 


my  +  k1y  +  k2y2  =  F,  (42) 

where  y(t)  is  the  forward  speed  or  yaw  rate,  m  is  the  inertia,  kt  is  the  linear  drag 
term,  k2  is  the  quadratic  term,  and  F  is  the  constant  thrust  or  torque.  In  Section 
3  below,  the  linear  term,  kx ,  can  be  neglected  for  the  Clearpath  USV.  For  a 
constant  input,  F  ,  the  solution  to  the  differential  equation  (42)  takes  the  form  of 

y(t)  =  yatonh(ysa%t),  (43) 
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where  yss  is  the  steady  state  velocity.  The  drag  coefficient,  kA ,  from  the  steady- 

state  experiment  results  is  known,  so  there  are  two  unknown  parameters,  the 
total  inertia  (m)  (which  includes  the  sum  of  the  rigid  body  and  added  mass)  and 
the  steady-state  velocity  ( yss). 

To  estimate  these  two  parameters,  the  inertia  and  the  steady-state 
velocity,  step-response  tests  were  conducted  on  the  USV.  Starting  at  zero 
velocity,  the  USV  was  given  constant  thrust  commands  and  allowed  to  reach 
steady  state  velocity.  Once  the  USV  was  at  a  steady,  consistent  velocity,  the 
input  command  was  stopped  and  the  USV  decelerated  on  its  own.  This 
procedure  was  repeated  at  discrete  levels  of  thrust  and  then  the  curve  in 
Equation  (42)  was  fit  to  the  experimental  data  by  finding  values  of  and  m  to 
minimize  the  error  between  the  model  of  Equation  (42)  and  the  data. 
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For  the  surge  direction,  at  three  discrete  input  levels,  the  results  of  this 
process  are  presented  in  Figure  10  through  Figure  12.  The  added  mass  in  the  surge 
direction  was  calculated  using  Equation  (38),  and  the  mass  data  is  tabulated  in 
Table  2. 


Figure  1 0.  Added  Mass  Surge  Data  for  Vss=0.27  m/s 
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Figure  1 1 .  Added  Mass  Surge  Data  for  Vss=0.81  m/s 
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Figure  1 2.  Added  Mass  Surge  Data  for  Vss=1 .02  m/s 


Table  2.  Curve  Fit  Results  for  Surge  Added  Mass  Model 


Surge  Fit  Data 

Vss  (m/s) 

0.27 

0.81 

1.02 

95%  Confidence 
Bounds  for  Vss 
(m/s) 

0.27,  0.28 

0.80,  0.81 

1.02,  1.03 

Mass  (kg) 

40.40 

82.20 

62.57 

95%  Confidence 
Bounds  for 

Mass  (kg) 

39.12,  41.67 

80.85,  83.54 

61.48,  63.66 
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The  added  mass  for  three  different  steady-state  velocities  is  displayed  in 
Table  2.  The  mass  increased  as  the  velocity  increased  until  the  steady-state 
velocity  reached  1 .02  m/s.  The  added  mass  decreased  from  82.20  to  62.57  kg  at 
1 .02  m/s.  Confidence  bounds  were  also  calculated  for  the  steady-state  velocities 
and  the  added  mass. 

For  the  yaw  direction,  the  USV  was  given  torque  commands  to  spin  in  a 
clockwise  circle  and  allowed  to  reach  steady  state  angular  velocity.  Once  the 
USV  was  at  a  steady,  consistent  angular  velocity,  the  input  command  was 
stopped,  and  the  USV  decelerated  on  its  own.  The  step  response  in  yaw  was 
measured.  The  result  is  data  for  each  step  response  experiment.  MATLAB  was 
used  to  fit  a  curve  to  the  data,  which  is  presented  in  Figure  13  and  Figure  14. 
The  added  inertia  in  the  yaw  direction  was  determined  using  Equation  (40),  and 
the  inertia  data  is  tabulated  in  Table  3. 


Figure  13.  Added  Inertia  Yaw  Data  for  Vss=0.16  rad/s 
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Figure  1 4.  Added  Inertia  Yaw  Data  for  Vss=0.25  rad/s 


Table  3.  Curve  Fit  Results  for  Yaw  Added  Inertia  Model 


Yaw  Fit  Data 

Vss  (rad/s) 

0.16 

0.25 

95%  Confidence 

Bounds  for  Vss  (rad/s) 

0.16,  0.16 

0.24,0.25 

Moment  of  Inertia 
(kg*mA2) 

8.32 

16.38 

95%  Confidence 

Bounds  for  Inertia 
(kg*mA2) 

5.73,  10.92 

13.12,  19.64 

The  added  moment  of  inertia  for  two  different  steady-state  angular 
velocities  is  displayed  in  Table  3.  The  inertia  nearly  doubled  from  8.32  to  16.38 
kg*mA2,  as  the  angular  velocity  increased  from  0.16  to  0.25  rad/s.  Confidence 
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bounds  were  also  calculated  for  the  steady-state  angular  velocities  and  the 
added  inertia. 

2.  Thrust  Model 

The  thrust  generated  by  each  of  the  two  thrusters  on  the  USV  is  a  function 
of  the  motor  command  given  to  the  onboard  motor  controller.  Typically,  this 
motor  command  is  proportional  to  the  voltage  of  the  internal  motor.  In  this  section 
the  functional  relationship  between  the  thrust  command,  a  value  between  -1.0 
(reverse)  and  1.0  (forward),  and  the  resulting  thrust  force  generated  by  the 
thruster  assembly  on  the  Clearpath  USV  is  identified. 

A  bollard  pull  test  was  performed  in  the  CAVR  test  tank  to  evaluate  this 
relationship.  The  USV  was  given  thrust  commands  from  -1.0  (reverse)  to  1.0 
(forward)  while  statically  attached  to  the  side  of  the  CAVR  test  tank  with  a  load 
cell  in  line  with  mooring.  The  voltage  output  from  the  load  cell  was  recorded  with 
a  16-bit  analog-to-digital  data  acquisition  system  and  the  calibration  in  Figure  17 
was  used  to  estimate  the  force  generated  at  discrete  thrust  commands. 
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The  forward  thrust  command  of  0.1  and  calculated  forces  are  presented  in 
Figure  15.  The  mean  force  and  standard  deviation  were  calculated  for  each  trial 
and  are  displayed  in  the  legend.  Figures  for  each  of  the  forward  command  trials 
are  located  in  the  Appendix. 
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Figure  15.  Forward  Thrust  Command  0.1 
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The  same  procedure  was  repeated  for  discrete  values  of  reverse  thrust. 
The  example  in  Figure  16  shows  the  results  for  a  reverse  thrust  of  0.2  and  the 
graphs  for  the  other  values  of  the  reverse  thrust  trials  are  included  in  the 
Appendix. 


Figure  1 6.  Aft  Thrust  Command  0.2 
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A  time-series  of  the  load  cell  force  is  generated  for  each  level  of 
commanded  thrust  with  N  values  between  -1.0  and  1.0.  The  mean  thrust 
standard  deviation  is  estimated  from  the  time-series.  Figure  17  illustrates  these 
values  for  the  range  of  thrust  commands.  A  line  of  best  fit  was  determined  to 
show  the  relationship  between  the  commands  and  the  static  forces.  The  line  of 
best  fit  in  Figure  17  shows  a  non-linear  relationship  between  the  commands  and 
outputted  thrust.  The  plot  is  not  symmetric  and  illustrates  the  lack  of  reverse 
thrust  of  the  USV.  The  forward  thrust  direction  is  much  more  effective  and 
increases  until  settling  out  at  40.0  N. 


Figure  17.  Thrust  Command  Relationship 


3.  Drag  Coefficient  Identification 

To  estimate  the  hydrodynamic  drag  terms  in  the  USV  model  from 
Equations  (38)  and  (40),  a  series  of  steady-state  velocity  tests  were  completed  in 
the  surge  and  yaw  directions  of  motion.  For  each  test,  a  constant  input  (thrust  for 

surge  and  torque  for  yaw)  was  imposed  and  the  steady-state  velocity  (forward 
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velocity  and  angular  velocity)  was  measured  by  the  onboard  inertial 
measurement  unit  (IMU)/Global  Positioning  System  (GPS)  sensor.  The 
relationship  between  constant  input  and  steady-state  velocity  is  then  used  to 
estimate  the  coefficients  of  drag. 

The  mean  steady  state  surge  and  yaw  values  were  interpolated  for  each 
thrust  command.  The  data  along  with  a  curve  of  best  fit  is  displayed  in  Figure  18 
and  Figure  19. 


Figure  18.  Steady  State  Surge  Test 
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Angular  Velocity  [rad/s] 


Figure  19.  Steady  State  Yaw  Test 
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The  thrust  command  curve  presented  in  Figure  17  was  used  to  estimate  the 
thrust/torque  that  correlated  with  the  thrust  commands  for  each  test.  This  allows  us 
to  examine  the  relationship  between  velocity  and  thrust  force  and  angular  velocity 
and  total  torque.  Figure  20  is  the  total  thrust  force  versus  steady  state  forward  speed 
and  Figure  21  is  the  total  torque  versus  steady  state  yaw  rate. 


Figure  20.  Thruster  Force  versus  Steady-State  Velocity  with  Curves  of 

Best  Fit 
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The  curves  of  best  fit  for  Figure  20  are 


fo(x)  =  23.24x2  -  10.04x  + 1 .395 , 

(44) 

fo(x )  =  21.62x2  -6.736x , 

(45) 

fo(x)  =  16.9  lx2. 

(46) 

Table  4  quantifies  three  possible  models  for  the  hydrodynamic  drag  in  the 
surge  direction.  The  models  each  contain  a  subset  of  the  following  parameters: 

•  a:  quadratic  coefficient 

•  b:  linear  coefficient 

•  c:  constant  coefficient. 


Table  4.  Curve  Fit  Results  for  Surge  Drag  Model  with  Goodness 

of  Fit  Metrics 


Drag  Model 
Formulas  for 
the  Fit 

Coefficients 

95% 

Confidence 

Bounds 

Sum  of 
Squares 
due  to 
Error 
(SSE) 

Adjusted 

RA2 

Root 

Mean 

Square 

Error 

(RMSE) 

Polynomial: 

fo(x)=a*xA2+b*x 

+c 

a=23.24 

15.96, 

30.52 

37.1464 

0.9846 

2.1548 

b=-10.04 

-22.17, 

2.081 

c=1 .395 

-2.359, 

5.149 

Linear  + 

Quadratic: 

fo(x)=a*xA2+b*x 

a=21 .62 

15.98, 

27.27 

40.5551 

0.9850 

2.1228 

b=-6.736 

-14.69,  1.22 

Quadratic  Only 
fo(x)=a*xA2 

a=16.91 

15.91,  17.9 

57.0866 

0.9810 

2.3893 
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As  the  number  of  coefficients  in  the  drag  model  are  reduced,  the 
goodness-of-fit  metrics  indicate  a  reduction  in  the  agreement  between  the  drag 
model  and  the  observed  data.  The  model  that  includes  all  three  terms 
(Polynomial)  has  a  non-zero  constant  term  (c)  which  would  suggest  that  the  USV 
would  have  a  non-zero  forward  velocity  with  no  applied  force,  which  is  not 
consistent  with  experimental  evidence.  The  Linear+Quadratic  model  results 
include  a  linear  coefficient  (b)  that  is  negative,  which  is  also  not  physically 
consistent  with  the  operation  of  the  USV.  Furthermore,  the  goodness-of-fit 
metrics  suggest  that  the  quality  of  the  fit  for  the  Quadratic  Only  model  is  similar  to 
that  of  the  Polynomial  and  Linear+Quadratic  formulations.  The  Quadratic  Only 
model  of  drag  in  the  surge  direction  was  used  due  to  the  consistency  of  the 
physical  operation,  small  change  in  fit  quality,  and  the  qualitative  assessment  of 
Figure  20.  Therefore,  the  model  terms  in  Equation  (38)  are 

Xuu  =  0,  (47) 

Xw\u\u  =  \6.9N  liml  sf .  (48) 

The  curves  of  best  fit  for  Figure  21  are 


to(x)  =  93.86x2  +10.35x- 0.077  , 

(49) 

to(x )  =  97.15x2  +  9.265x  , 

(50) 

to{x )  =138.9x2 . 

(51) 
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Figure  21 .  Torque  versus  Steady-State  Angular  Velocity  with  Curves 

of  Best  Fit 
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The  results  of  model  fitting  for  the  yaw  drag  experiments  are  reported  in 
Table  5. 


Table  5.  Curve  Fit  Results  for  Yaw  Drag  Model  with  Goodness 

of  Fit  Metrics 


Drag  Model 
Formulas  for 
the  Fit 

Coefficients 

95% 

Confidence 

Bounds 

Sum  of 
Squares 
due  to 
Error 
(SSE) 

Adjusted 

RA2 

Root 

Mean 

Square 

Error 

(RMSE) 

Polynomial: 

to(x)=a*xA2+b 

*x+c 

a=93.86 

54.39, 

133.3 

0.8666 

0.9898 

0.3291 

b=10.35 

0.07937, 

20.63 

c=-0. 07664 

-0.6026, 

0.4493 

Linear+ 

Quadratic 

to(x)=a*xA2+b 

*x 

a=97.15 

67,  127.3 

0.8788 

0.9908 

0.3125 

b=9.265 

2.699, 

15.83 

Quadratic 

Only 

to(x)=a*xA2 

a=138.9 

131,  146.8 

1 .8738 

0.9823 

0.4329 

The  same  reasoning  as  described  for  the  surge  drag  model  identification 
is  followed.  For  the  yaw  case,  it  could  be  argued  that  the  Linear+Quadratic  model 
should  be  used  because  it  more  closely  agrees  with  the  experimental  results,  as 
shown  in  Figure  21 .  The  Quadratic  Only  model  has  been  chosen  for  consistency 
and  since  it  simplifies  the  identification  of  the  added  mass  and  provides  an 
acceptable  goodness-of-fit.  The  resulting  model  parameters  from  Equation  (40) 
are 


N,.r  =  0, 


(52) 


Nr |r|  r  r  =  139  Nm  /  ( rad  /  s )2 . 


(53) 
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4. 


Model  Parameters 


The  calculated  model  parameters  identified  in  Sections  1  through  3  in  this 
chapter  are  collected  in  Table  6. 

Table  6.  Identified  USV  Model  Values 


Description 

Variable 

Value  [units] 

Rigid  Body  Mass 

m 

36.0  kg 

Added  Mass,  Surge 

** 

61 .7  kg  (mean  from  Table  2) 

Linear  Drag,  Surge 

*uu 

0.0  N/(m/s ) 

Quadratic  Drag,  Surge 

X, ,  \u\u 

16.9  N/(m/s)2 

Thrust,  Surge 

t{c) 

Figure  20 

Added  Mass,  Sway 

n 

N/A 

Added  Mass  Coriolis,  Sway 

Kr 

N/A 

Linear  Drag,  Sway 

N/A 

Quadratic  Drag,  Sway 

Fjvlv 

N/A 

Rigid  Body  Inertia,  Yaw 

h 

8.35  kg  -m 2 

Added  Mass  Inertia,  Yaw 

12.4  kg-m 2  (mean  from  Table  3) 

Linear  Drag,  Yaw 

Nrr 

0.0  N  -ml  ( rad  /  s) 

Quadratic  Drag,  Yaw 

N  i  Mr 

'In  I  I 

139.0  N -ml (rad  Is)2 

Torque,  Yaw 

T(c) 

Figure  21 
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D.  GAZEBO  SIMULATION  IMPLEMENTATION 

The  Clearpath  USV  is  a  3  DOF  model  while  the  Gazebo  simulation  that 
was  developed  is  a  6  DOF  model.  For  simulation  purposes,  only  the 
maneuvering  model  is  necessary.  The  inertia  and  damping  values  are  assumed 
for  roll  and  pitch,  respectively.  In  the  heave  direction,  a  constant  cross  section  for 
the  buoyancy  calculation  and  a  damping  coefficient  are  assumed.  The  Gazebo 
USV  plug-in  is  presented  in  Figure  22. 


*  Gaicbo 


Hi-  Edit  Viuw  Window  Hcip 


II  1  UtffH  1  R«l  Time  Frrcco*"-  Sim  Time  Time  Hrraftwvy  Fv.-rt 


Figure  22.  USV  Gazebo  Simulation  Environment 
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IV.  EXPERIMENTAL  RESULTS 


A.  EXPERIMENTAL  SETUP 
1.  Load  Cell  Setup 

A  load  cell  was  calibrated  using  measured  weights  and  connected  to  a 
multifunction  data  acquisition  module.  The  external  and  load  voltages  were 
measured  along  with  the  force  in  units  of  newton.  The  calibration  data  along  with 
the  line  of  best  fit  equation  is  shown  in  Figure  23. 


Figure  23.  Load  Cell  Calibration 


The  Clearpath  USV  was  connected  to  the  calibrated  load  cell  and  placed 
in  a  water  tank  to  measure  various  parameters  and  identify  characteristics  of  the 
USV. 
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2.  MATLAB  and  Simulink  Setup 

MATLAB  and  Simulink  were  chosen  to  implement  the  high  level  potential 
field  controller.  Figure  24  is  a  block  diagram  of  the  control  system  and  hardware 
used. 


Course  command 
(cmd  velocity  and  heading) 


(X,Y) 

[Local  Frame) 


USV 


4 - 

Velr  Yaw 


Drive  command 
(left  and  right  thruster) 


Low-Level  Controller 
Python 


Geonav 


Navigation  data 
[Global  Frame] 


Clearpath  USV 


Microstrain 

IMU/GP5 


Figure  24.  Control  System  Block  Diagram 


The  course  commands  are  passed  via  Wi-Fi  to  the  USV  where  the  low- 
level  controller  uses  the  velocity  and  heading  commands  as  setpoints  (goals)  for 
the  low-level  feedback  control.  The  output  of  this  low-level  controller  is  a  drive 
command  for  the  left  and  right  thrusters.  Odometry  data  (position,  velocity, 
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attitude  and  attitude-rate)  from  the  micro-strain  IMU/GPS  is  passed  back  to  the 
low-level  controller  and  potential  field  controller  to  complete  the  feedback  loop. 

The  potential  field  controller  was  developed  incrementally  in  the  Gazebo 
simulation  environment,  presented  in  Figure  25. 


Figure  25.  Gazebo  Simulation  of  Lake  El  Estero 
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Once  the  controller  worked  properly  in  the  simulation  then  it  was  tested 
with  the  USV  at  the  lake,  shown  in  Figure  26. 


Figure  26.  Lake  El  Estero.  Adapted  from  [10]. 
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Adjustments  were  made  at  the  lake  to  account  for  differences  in 
geography  between  the  Gazebo  simulations  and  the  lake.  The  initial  controller 
had  one  repulsive  field,  the  obstacle,  and  one  attractive  field,  the  target.  The 
basic  Simulink  model  is  shown  in  Figure  27  through  Figure  29.  Figure  27  shows 
the  ROSNODE  block  for  the  position  of  the  USV,  the  position  of  the  target,  and 
the  attractive  force  inputs.  Figure  28  displays  the  position  of  the  obstacle  and  the 
repulsive  force  inputs.  Figure  29  presents  the  summation  of  the  attractive  and 
repulsive  forces,  and  yaw  and  speed  commands.  The  yaw  and  speed  commands 
are  passed  to  the  USV  though  a  ROSNODE  block.  The  next  increment  was 
adding  three  obstacles  to  observe  the  interaction  of  the  USV  and  multiple 
obstacles.  The  final  iteration  was  creating  repulsive  potential  line  fields  along  the 
sides  of  the  lake  to  create  a  channel  with  one  obstacle  and  one  target.  The 
results  are  discussed  in  Sections  B  and  C  of  this  chapter. 


Figure  27.  USV  Position  and  Attractive  Force  in  Simulink  Model 
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Figure  28.  Obstacle  and  Repulsive  Force  in  Simulink  Model 


Figure  29.  Sum  of  Forces  and  Yaw/Speed  Commands  in  Simulink  Model 

The  size  of  the  radius  of  influence  of  the  obstacle  was  determined  by 
analyzing  the  dynamic  surge  tests.  The  USV  was  given  the  maximum  speed 
command  and  allowed  to  reach  steady  state  velocity.  The  input  command  was 
then  stopped  and  the  USV  decelerated  on  its  own.  An  assumption  was  made  that 
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the  vehicle  would  be  able  to  slow  down  safely  before  reaching  the  obstacle 
based  on  the  time  and  distance  it  takes  to  go  from  100%  to  10%  of  maximum 
speed.  The  time  was  measured  and  the  distance  to  slow  down  was  calculated, 
approximately  10  meters,  by  integrating  the  area  underneath  the  speed  curve. 
The  curve  is  shown  in  Figure  30. 


Figure  30.  Obstacle  Radius  of  Influence  Size 


The  obstacles  in  the  repulsive  potential  field  line  tests  have  a  radius  of  10 
meters  due  to  the  analysis  in  Figure  30.  The  MATLAB  and  Simulink  code  from 
the  experiments  are  found  in  https://gitlab.nps.edu/namanzin/potential_ 
field_NPS_thesis.git. 
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B.  GAZEBO  EXPERIMENTAL  RESULTS 


The  initial  test  in  the  Gazebo  simulation  was  one  obstacle  and  one  target. 
The  USV  is  travelling  toward  the  top  of  the  plot  and  its  position  is  plotted  in 
Figure  31 .  In  Figure  31  through  Figure  33,  the  obstacle  has  an  inner  radius  (solid 
red  circle)  of  5  meters  and  an  outer  repulsive  influence  radius  (dashed  red  circle) 
of  5  meters.  The  target  (dashed  green  circle)  has  a  radius  of  10  meters.  Both  the 
obstacle  and  target  have  a  constant  positive  gain  of  10. 


Figure  31 .  USV  Position  with  One  Obstacle  in  Gazebo 

The  USV  interacts  with  the  attractive  potential  field  in  Figure  31  until  it 
crosses  the  repulsive  radius  of  influence  (dashed  red  circle).  The  USV 
maneuvers  back  and  forth  across  the  radius  of  influence  toward  the  target,  where 
it  stops  once  it  crosses  the  attractive  radius  of  influence  (dashed  green  circle). 
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The  command  speed  and  heading  of  the  USV  are  plotted  in  Figure  32. 
The  quiver  plot  in  the  figure  illustrates  the  command  course  data  that  is  being 
passed  to  the  USV  from  the  potential  field  controller. 


Figure  32.  USV  Command  Yaw  and  Speed  with  One  Obstacle  in  Gazebo 
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Figure  33  displays  the  speed  and  heading  of  USV  measured  by  the 
simulated  IMU  in  Gazebo.  The  figure  illustrates  how  the  USV  converted  the 
commanded  yaw  and  speed  into  simulated  maneuvers  to  avoid  the  obstacle  and 
reach  the  target. 


Figure  33.  USV  Yaw  and  Speed  with  One  Obstacle  in  Gazebo 
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The  final  test  in  Gazebo  was  the  USV  navigating  between  a  repulsive 
potential  line  channel  and  one  obstacle.  Figure  34  shows  the  USV  transiting 
around  the  obstacle  without  any  interaction  with  the  boundary  toward  the  top  of 
the  plot.  In  Figure  34  through  Figure  36,  the  channel  is  represented  with  two  solid 
blue  lines.  The  inner  repulsive  potential  field  lines  (dashed  red  line)  are  2  meters 
from  the  solid  blue  channel  lines.  The  outer  repulsive  potential  field  lines  (dashed 
red  line)  are  5  meters  from  the  solid  blue  channel  lines.  The  potential  field  lines 
have  a  constant  positive  repulsive  gain  of  10.  The  middle  obstacle  has  an  inner 
radius  (solid  red  circle)  of  1  meter  and  an  outer  repulsive  influence  radius 
(dashed  red  circle)  of  10  meters.  The  target  (dashed  green  circle)  has  an 
attractive  influence  radius  of  10  meters.  The  obstacle  has  a  constant  positive 
gain  of  1 0  while  the  target  has  a  gain  of  1 . 


Figure  34.  USV  Position  with  Repulsive  Channel  and  One 

Obstacle  in  Gazebo 
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The  command  speed  and  heading  of  the  USV  are  plotted  in  Figure  35. 


Figure  35.  USV  Command  Yaw  and  Speed  with  Repulsive  Channel  and 

One  Obstacle  in  Gazebo 
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In  Figure  36,  the  USV  is  shown  proceeding  toward  the  target,  crossing  the 
radius  of  influence  of  the  obstacle  (dashed  red  circle),  and  turning  in  the  opposite 
direction  with  a  large  increase  in  speed.  The  USV  then  turns  toward  the  potential 
line  boundary  (dashed  red  line)  and  maneuvers  toward  the  target  (dashed  green 
circle)  at  the  top  of  the  plot. 


Figure  36.  USV  Yaw  and  Speed  with  Repulsive  Channel  and  One 

Obstacle  in  Gazebo 

The  Gazebo  simulations  validated  that  the  potential  field  controller 
developed  in  Simulink  worked.  The  follow-on  experiment  was  to  integrate  the 
controller  with  the  Kingfisher  USV  and  test  it  in  a  real  world  environment,  Lake  El 
Estero.  Multiple  experiments  involving  known  potential  field  obstacles  and 
boundary  lines  were  conducted  and  discussed  in  Section  C. 
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C.  LAKE  EL  ESTERO  EXPERIMENTAL  RESULTS 

As  discussed  earlier  the  initial  test  was  one  obstacle  and  one  target.  The 
USV  is  travelling  toward  the  top  of  the  plot  and  its  position  is  plotted  in  Figure  37. 
In  Figure  37  through  Figure  39,  the  obstacle  has  an  inner  radius  (solid  red  circle) 
of  5  meters  and  an  outer  repulsive  influence  radius  (dashed  red  circle)  of  5 
meters.  The  target  (dashed  green  circle)  has  a  radius  of  10  meters.  Both  the 
obstacle  and  target  have  a  constant  positive  gain  of  10. 


Figure  37.  USV  Position  with  One  Obstacle 

The  USV  initially  only  interacts  with  the  attractive  potential  field  in  Figure 
37  until  it  crosses  the  repulsive  radius  of  influence  (dashed  red  circle).  The  USV 
maneuvers  to  exit  the  radius  of  influence  and  continues  to  the  target,  where  it 
stops  once  it  crosses  the  attractive  radius  of  influence  (dashed  green  circle). 
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The  command  speed  and  heading  of  the  USV  are  plotted  in  Figure  38. 
The  quiver  plot  in  the  figure  illustrates  the  command  course  data  that  is  being 
passed  to  the  USV  from  the  potential  field  controller. 
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Figure  38.  USV  Command  Yaw  and  Speed  with  One  Obstacle 
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Figure  39  displays  the  speed  and  heading  of  the  USV  measured  by  the 
micro-strain  IMU/GPS.  The  figure  illustrates  how  the  USV  converted  the 
commanded  yaw  and  speed  into  real-world  maneuvers  to  avoid  the  obstacle  and 
reach  the  target. 


Figure  39.  USV  Yaw  and  Speed  with  One  Obstacle 
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The  next  test  was  implementing  three  obstacles  and  one  target.  The  USV 
is  travelling  toward  the  top  of  the  plot  and  its  position  is  plotted  in  Figure  40.  In 
Figure  40  through  Figure  42,  the  two  smaller  obstacles  have  an  inner  radius 
(solid  red  circle)  of  1  meter  and  an  outer  repulsive  influence  radius  (dashed  red 
circle)  of  5  meters.  The  middle  obstacle  has  an  inner  radius  (solid  red  circle)  of  5 
meters  and  an  outer  repulsive  influence  radius  (dashed  red  circle)  of  5  meters. 
The  target  (dashed  green  circle)  has  a  radius  of  10  meters.  Both  the  obstacles 
and  target  have  a  constant  positive  gain  of  1 0. 


Figure  40.  USV  Position  with  Three  Obstacles 
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The  USV  only  interacts  with  the  large  middle  obstacle  while  transiting 
toward  the  target.  The  command  speed  and  heading  of  the  USV  are  plotted  in 
Figure  41 . 
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Figure  41 .  USV  Command  Yaw  and  Speed  with  Three  Obstacles 
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Figure  42  displays  the  speed  and  heading  of  the  USV  measured  by  the 
micro-strain  IMU/GPS.  The  figure  once  again  illustrates  how  the  USV  converted 
the  commanded  yaw  and  speed  into  real-world  maneuvers  to  avoid  the  obstacles 
and  reach  the  target. 


Figure  42.  USV  Yaw  and  Speed  with  Three  Obstacles 
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The  next  test  was  a  return  trip  of  the  USV  between  the  three  obstacles.  The 
previous  starting  position  is  now  the  target  and  the  USV  is  travelling  toward  the 
bottom  of  the  plot  in  Figure  43.  In  Figure  43  through  Figure  45,  the  two  smaller 
obstacles  have  an  inner  radius  (solid  red  circle)  of  1  meter  and  an  outer  repulsive 
influence  radius  (dashed  red  circle)  of  5  meters.  The  middle  obstacle  has  an  inner 
radius  (solid  red  circle)  of  5  meters  and  an  outer  repulsive  influence  radius  (dashed 
red  circle)  of  5  meters.  The  target  (dashed  green  circle)  has  a  radius  of  10  meters. 
Both  the  obstacles  and  target  have  a  constant  positive  gain  of  10. 


Figure  43.  USV  Return  Trip  with  Three  Obstacles 
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The  USV  crosses  the  middle  obstacle’s  radius  of  influence  (dashed  red 
circle)  and  turns  toward  the  smaller  obstacle.  The  USV  then  interacts  with  the 
repulsive  field  of  the  smaller  boundary  (dashed  red  circle)  and  turns  toward  the 
target  to  complete  the  test.  The  command  speed  and  heading  of  the  USV  are 
plotted  in  Figure  44. 


Figure  44.  USV  Command  Yaw  and  Speed  with  Three  Obstacles 
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Figure  45  displays  the  speed  and  heading  of  the  USV’s  return  trip 
measured  by  the  micro-strain  IMU/GPS.  The  most  noticeable  aspect  of  the 
quiver  plot  is  the  increase  in  the  size  of  the  arrows,  the  USV  speed,  when  the 
USV  exits  the  radius  of  influence  (dashed  red  circle)  of  both  obstacles. 


Figure  45.  USV  Yaw  and  Speed  with  Three  Obstacles 
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The  final  test  was  the  USV  navigating  between  a  repulsive  potential  line 
channel  and  one  obstacle.  Figure  46  shows  the  USV  transiting  toward  the  top  of 
the  plot  without  any  interaction  with  the  channel.  In  Figure  46  through  Figure  48, 
the  channel  is  represented  with  two  solid  blue  lines.  The  inner  repulsive  potential 
field  lines  (dashed  red  line)  are  2  meters  from  the  solid  blue  channel  lines.  The 
outer  repulsive  potential  field  lines  (dashed  red  line)  are  5  meters  from  the  solid 
blue  channel  lines.  The  potential  field  lines  have  a  constant  positive  repulsive 
gain  of  10.  The  middle  obstacle  has  an  inner  radius  (solid  red  circle)  of  1  meter 
and  an  outer  repulsive  influence  radius  (dashed  red  circle)  of  10  meters.  The 
target  (dashed  green  circle)  has  an  attractive  influence  radius  of  10  meters.  The 
obstacle  has  a  constant  positive  gain  of  10  while  the  target  has  a  gain  of  1 . 


Figure  46.  USV  Position  with  Repulsive  Channel  and  One  Obstacle 
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The  command  speed  and  heading  of  the  USV  are  plotted  in  Figure  47. 


Figure  47.  USV  Command  Yaw  and  Speed  with  Repulsive  Channel  and 

One  Obstacle 
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Figure  48  displays  the  speed  and  heading  of  the  USV’s  trip  measured  by 
the  micro-strain  IMU/GPS. 


Figure  48.  USV  Yaw  and  Speed  with  Repulsive  Channel  and  One 

Obstacle 
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In  Figure  49,  the  USV  is  shown  starting  inside  the  repulsive  potential  line 
channel  and  moving  toward  the  target  at  the  top  of  the  plot.  In  Figure  49  through 
Figure  51 ,  the  channel  is  represented  with  two  solid  blue  lines.  The  inner  repulsive 
potential  field  lines  (dashed  red  line)  are  2  meters  from  the  solid  blue  channel 
lines.  The  outer  repulsive  potential  field  lines  (dashed  red  line)  are  5  meters  from 
the  solid  blue  channel  lines.  The  potential  field  lines  have  a  constant  positive 
repulsive  gain  of  10.  The  middle  obstacle  has  an  inner  radius  (solid  red  circle)  of  1 
meter  and  an  outer  repulsive  influence  radius  (dashed  red  circle)  of  10  meters.  The 
target  (dashed  green  circle)  has  an  attractive  influence  radius  of  10  meters.  The 
obstacle  has  a  constant  positive  gain  of  5  while  the  target  has  a  gain  of  1 .  The 
USV  is  repelled  by  the  channel  potential  field  (dashed  red  line)  and  only  interacts 
with  the  attractive  target  field  until  it  crosses  the  obstacle’s  repulsive  radius  of 
influence  (dashed  red  circle).  The  USV  then  exits  the  obstacle  and  continues  on 
its  track  toward  the  target. 


Figure  49.  USV  Position  with  Repulsive  Channel  and  One  Obstacle 
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The  command  speed  and  heading  of  the  USV  are  plotted  in  Figure  50. 
The  commanded  speed  and  direction  are  approximately  perpendicular  to  the 
repulsive  potential  field  line  (dashed  red  line)  in  the  figure.  The  repulsive  field 
forces  the  USV  to  exit  the  boundary  toward  the  middle  of  the  channel.  The  USV 
then  begins  to  turn  toward  the  attractive  field  of  the  target  until  it  maneuvers 
around  the  obstacle  (dashed  red  circle)  to  reach  the  goal  (dashed  green  circle). 


Figure  50.  USV  Command  Yaw  and  Speed  with  Repulsive  Channel  and 

One  Obstacle 


71 


Figure  51  displays  the  speed  and  heading  of  the  USV’s  trip  measured  by 
the  micro-strain  IMU/GPS.  Once  again,  the  largest  speeds  of  the  USV  are  when 
it  is  exiting  a  repulsive  field  boundary  (dashed  red  line)  and  the  obstacle  (dashed 
red  circle).  Upon  exiting  the  obstacle,  the  yaw  of  the  USV  turns  toward  the  target 
(dashed  green  circle)  due  to  the  attractive  potential  field. 


Figure  51 .  USV  Yaw  and  Speed  with  Repulsive  Channel  and  One 

Obstacle 
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The  next  test  was  a  return  trip  of  the  USV  between  the  channel  and  the 
boundary.  The  previous  starting  position  is  now  the  target  and  the  USV  is 
travelling  toward  the  bottom  of  the  plot  in  Figure  52.  In  Figure  52  through  Figure 
54,  the  channel  is  represented  with  two  solid  blue  lines.  The  inner  repulsive 
potential  field  lines  (dashed  red  line)  are  2  meters  from  the  solid  blue  channel 
lines.  The  outer  repulsive  potential  field  lines  (dashed  red  line)  are  5  meters  from 
the  solid  blue  channel  lines.  The  potential  field  lines  have  a  constant  positive 
repulsive  gain  of  10.  The  middle  obstacle  has  an  inner  radius  (solid  red  circle)  of 
1  meter  and  an  outer  repulsive  influence  radius  (dashed  red  circle)  of  10  meters. 
The  target  (dashed  green  circle)  has  an  attractive  influence  radius  of  10  meters. 
The  obstacle  has  a  constant  positive  gain  of  5  while  the  target  has  a  gain  of  1 . 
The  USV  navigates  between  the  obstacle  (dashed  red  circle)  and  the  potential 
line  channel  (dashed  red  lines)  while  transiting  to  the  target.  Both  the  attractive 
and  repulsive  fields  interact  appropriately  with  the  USV.  The  repulsive  field  of  the 
potential  lines  force  the  USV  out  of  the  boundary  and  the  attractive  field  of  the 
target  (dashed  green  circle)  draws  the  USV  toward  it. 


Figure  52.  USV  Return  Trip  with  Repulsive  Channel  and  One  Obstacle 
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The  command  speed  and  heading  of  the  USV  are  plotted  in  Figure  53. 


Figure  53.  USV  Command  Yaw  and  Speed  with  Repulsive  Channel  and 

One  Obstacle 

The  repulsive  forces  of  the  potential  line  are  perpendicular  to  the  boundary 
(dashed  red  lines)  and  direct  the  USV  toward  the  obstacle  (dashed  red  circle), 
but  are  minimized  due  to  the  opposing  forces  of  the  obstacle. 
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Figure  54  displays  the  speed  and  heading  of  the  USV’s  return  trip 
measured  by  the  micro-strain  IMU/GPS.  The  USV  enters  the  middle  obstacle 
(dashed  red  circle)  and  turns  nearly  perpendicular  to  exit  it.  The  USV  then  points 
directly  into  the  potential  line  boundary  (dashed  red  lines)  in  Figure  54.  Inside  the 
boundary,  the  USV  turns  toward  the  target  (dashed  green  circle)  and  speeds  up 
to  exit  the  repulsive  potential  line.  The  potential  field  controller  and  the  USV  all 
perform  as  expected  to  ensure  the  USV  maneuvers  away  from  repulsive 
potential  fields  and  toward  the  attractive  potential  field. 


Figure  54.  USV  Yaw  and  Speed  with  Repulsive  Channel  and  One 

Obstacle 
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D.  COMPARISON  OF  GAZEBO  AND  LAKE  EL  ESTERO  RESULTS 

The  USV  tracks  from  the  Gazebo  simulations  and  Lake  El  Estero 
experiments  were  plotted  together  to  compare  the  differences  between  the 
simulated  and  actual  USV.  Figure  55  presents  the  experiment  with  one  obstacle 
and  is  a  combination  of  Figure  31  and  Figure  37. 


Figure  55.  Combined  USV  Plots  with  One  Obstacle 


The  USVs  begin  the  experiment  transiting  toward  the  attractive  potential 
field  in  the  same  direction.  The  simulated  USV  (dark  blue  line)  reacts 
immediately  with  the  repulsive  potential  field  obstacle  and  continues  to  interact 
with  it  while  maneuvering  to  the  left.  The  real  world  USV  (light  blue  line)  requires 
more  time  and  space  to  react  to  the  obstacle.  The  momentum  of  the  USV 
requires  a  larger  repulsive  force  to  change  directions  and  speed  to  avoid  the 
obstacle.  The  USV  exits  the  obstacle’s  field  of  influence  (dashed  red  circle)  and 
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turns  toward  the  target  (dashed  green  circle)  to  complete  the  run.  The  major 
difference  between  the  two  experiments  was  the  interaction  with  the  obstacle  and 
the  direction  of  steering  around  it. 

Figure  56  combines  Figure  34  and  Figure  46  to  show  the  differences  of 
the  USVs  navigating  between  a  repulsive  potential  line  channel  and  one 
obstacle. 


Figure  56.  Combined  USV  Plots  with  Repulsive  Channel  and  One 

Obstacle 

Once  again,  both  USVs  proceeded  toward  the  attractive  potential  field  in 
the  same  direction.  The  simulated  USV  (dark  blue  line)  interacted  consistently 
with  the  obstacle  (dashed  red  circle)  to  steer  around  it.  The  real  world  USV  (light 
blue  line)  required  a  larger  repulsive  force  similar  to  Figure  55  to  avoid  the 
obstacle.  The  real  world  USV  exited  the  radius  of  influence  nearly  perpendicular 
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with  a  large  direction  and  speed  change.  Neither  USV  interacted  with  the 
potential  line  boundaries  during  the  experiment. 
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V.  CONCLUSION 


A.  SUMMARY  OF  RESULTS 

A  piecewise  linear  potential  field  model  was  implemented  on  the  Clearpath 
USV  using  MATLAB  and  Simulink.  The  dynamics  of  the  USV  were  measured 
and  tested  to  create  a  suitable  model  in  the  Gazebo  simulation  environment.  The 
USV  model  and  piecewise  linear  potential  field  model  were  tested  in  Gazebo  and 
in  the  field.  For  this  research,  the  location  of  all  obstacles  was  provided  to  the 
USV  a  prior.  The  simulations  and  field  experiments  were  compared  to  evaluate 
the  performance  of  the  USV  and  potential  field  algorithm.  The  qualitative  results 
show  that  the  simulation,  using  the  USV  maneuvering  model,  captures  the 
important  dynamics  of  the  USV  and  that  the  unavoidable  differences  between 
simulation  and  experiment  require  some  additional  tuning  of  the  algorithm 
parameters  in  the  field. 

Due  to  the  large,  nonrestrictive  test  area,  there  were  no  cases  of  the  USV 
reaching  a  local  minimum  and  becoming  stuck  [4],  The  USV  interacted  with  the 
piecewise  linear  potential  fields  in  a  consistent  and  expected  manner.  The 
repulsive  fields  forced  the  USV  to  change  direction  and  speed  to  exit  the 
obstacles  and  boundaries.  The  attractive  field  would  draw  the  USV  quickly  and 
directly  to  the  target.  The  interaction  between  the  repulsive  and  attractive  fields 
successfully  maneuvered  the  USV  around  obstacles  and  boundaries  to  reach  the 
objective. 

B.  PROPOSAL  FOR  FUTURE  STUDIES 

Future  work  includes  adding  more  obstacles  and  varying  the  spacing 
between  them  to  test  for  local  minimum  and  target  reachability.  Dynamic 
potential  fields  unknown  to  the  USV  would  test  the  performance  and  efficiency  of 
the  piecewise  linear  potential  field  model.  On  the  Clearpath  USV,  tuning  the  low- 
level  controller  would  improve  the  performance  (stability  and  tracking)  of  the 
USV.  A  camera  and  a  laser  range  finder  could  be  incorporated  to  identify 
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obstacles  and  targets.  Potential  fields  would  then  be  placed  around  those  objects 
allowing  the  USV  to  maneuver  safely  and  efficiently  to  complete  the  assigned 
task. 
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APPENDIX.  THRUST  COMMAND  DATA 
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Figure  57.  Forward  Thrust  Command  0.2 


Figure  58.  Forward  Thrust  Command  0.3 
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Figure  59.  Forward  Thrust  Command  0.4 
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Figure  60.  Forward  Thrust  Command  0.5 
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Figure  61 .  Forward  Thrust  Command  0.6 
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Figure  62.  Forward  Thrust  Command  0.7 
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Figure  63.  Forward  Thrust  Command  0.8 


Figure  64.  Forward  Thrust  Command  0.9 
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Figure  65.  Forward  Thrust  Command  1 .0 
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Figure  66.  Aft  Thrust  Command  0.3 
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Figure  67.  Aft  Thrust  Command  0.4 
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Figure  68.  Aft  Thrust  Command  0.5 
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Figure  69.  Aft  Thrust  Command  0.6 


Figure  70.  Aft  Thrust  Command  0.7 
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Figure  71 .  Aft  Thrust  Command  0.8 


Figure  72.  Aft  Thrust  Command  0.9 
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Figure  73.  Aft  Thrust  Command  1 .0 


89 


THIS  PAGE  INTENTIONALLY  LEFT  BLANK 


90 


LIST  OF  REFERENCES 


[1  ]  Department  of  the  Navy,  “The  Navy  unmanned  surface  vehicle  (USV) 
master  plan,  Program  Executive  Office  Littoral  and  Mine  Warfare  (PEO 
LMW),  Department  of  the  Navy,  Washington,  DC,  2007. 

[2]  Clearpath  Robotics,  (n.d.).  Heron  unmanned  surface  vessel.  [Online]. 
Available:  https://www.clearpathrobotics.com/heron-bathymetry- 
unmanned-surface-vessel/.  Accessed  Sept.  11, 2017. 

[3]  D.  Smalley.  (2014,  Oct.).  The  future  is  now:  Navy’s  autonomous 
swarmboats  can  overwhelm  adversaries.  Office  of  Naval  Research  (ONR). 
Arlington,  VA.  [Online].  Available:  https://www.onr.navy.mil/Media- 
Center/Press-Releases/2014/autonomous-swarm-boat-unmanned- 
caracas.aspx. 

[4]  J.  Latombe,  Robot  Motion  Planning.  Norwell,  MA:  Kluwer  Academic,  1991, 
pp.  295-310. 

[5]  Shaorong  Xie  et  al,  "The  obstacle  avoidance  planning  of  USV  based  on 
improved  artificial  potential  field,"  in  IEEE  International  Conference  on 
Information  and  Automation  (ICIA),  Hailar,  China,  2014,  pp.  746-751 . 

[6]  Michael  A.  Goodrich,  "Potential  fields  tutorial,"  Dept,  of  Computer  Science, 
Brigham  Young  University,  Provo,  UT,  unpublished. 

[7]  T.  I.  Fossen,  Handbook  of  Marine  Craft  Hydrodynamics  and  Motion 
Control.  Chichester,  West  Sussex,  England:  Wiley,  201 1 . 

[8]  T.  I.  Fossen,  Guidance  and  Control  of  Ocean  Vehicles.  Chichester,  West 
Sussex,  England:  Wiley,  1994. 

[9]  M.  Caccia,  G.  Bruzzone  and  R.  Bono,  "A  practical  approach  to  modeling 
and  identification  of  small  autonomous  surface  craft,"  in  IEEE  Journal  of 
Oceanic  Engineering,  vol.  33,  no.  2,  pp.  133-145,  Apr.  2008. 

[10]  Google  Maps.  (2017).  Lake  El  Estero,  Monterey,  CA  [Satellite  map]. 
Retrieved  from  https://www.google.eom/maps/@36.5963187,- 

1 21 .8883422, 356m/data=!3m1  !1e3 


91 


THIS  PAGE  INTENTIONALLY  LEFT  BLANK 


92 


INITIAL  DISTRIBUTION  LIST 


1 .  Defense  Technical  Information  Center 
Ft.  Belvoir,  Virginia 

2.  Dudley  Knox  Library 
Naval  Postgraduate  School 
Monterey,  California 


93 


